ESTIMATION OF SONOBUOY POSITION 
RELATIVE TO AN AIRCRAFT 
USING EXTENDED KALMAN FILTERS 



Nicholas Mason Brownsberger 



/ 



NAVAL POSTGRADUATE SCHOOL 

Monterey, California 




THESIS 



Estimation of Sonobuoy Position 
Relative to an Aircraft 
Using Extended Kalman Filters 

by 

Nicholas Mason Brownsberger 



September 1979 



Thesis Advisor: D. J. Collins 



Approved for public release; distribution uniimited 



T18958 




security classification of this PAOe r<Wi*n Dmtm Entmrmd) 



REPORT DOCUMENTATION PAGE 


READ INSTRUCTIONS 
BEFORE COMPLETING FORM 


1. REPORT NUMBER 


2. GOVT ACCESSIDN NO. 


3. RECIPIENT’S CAT ALOG NUMBER 


4 . TITLE SuSlllla; 

Estimation of Sonobuoy Position 
Relative to an Aircraft 
Using Extended Kalman Filters 


$. TYPE OF REPORT 8 PERIOD COVERED 

Master's and Engineer's 
Thesis; September 1979 


6. PERFDRMING DRG. REPORT NUMBER 


7. AUTHOnC*> 

Nicholas Mason Brownsberger 


8. CONTRACT OR GRANT NLMSERr*) 


9. PERFORMING ORGANIZATION NAME ANO AOORESS 

Naval Postgraduate School 
Monterey, California 939^0 


10. PROGRAM ELEMENT. PROJECT, TASK 
AREA & WORK UNIT NUMBERS 


1 1. CONTROLLING OFFICE NAME ANO AOORESS 

Naval Postgraduate School 
Monterey, California 939^0 


IZ. REPORT DATE 

September 1979 


13. NUMBER OF PAGES 


14. mDNITORING agency NAmI b AODRESS/’I/ dllUrmnt trom ControlHni OtIlcc) 

Naval Postgraduate School 
Monterey, California 939^0 


IS. security CLASS, (ol thtm rm^ri) 

Unclassified 


I5«. DECLASSIFICATION/ DOWNGRADING 

schedule 



16. OISTRiaUTION ST ATEMEN T ro/ (h/# R»porO 



Approved for public release; distribution unlimited 



t7. DISTRIBUTION STATEMENT (of ihm in Block 20^ // d///«r«n( /rooi Report) 



18. SUPPLEMENTARY NOTES 



If. KEY WORDS (Contintio on rmwmrom oldo II noemoomty mtd tdontlfy by block rumtbmr) 

SRS (Sonobuoy Reference System) 

Kalman Filter 
Sonobuoy 



20. abstract (Contimf on rmvorom aldo II noemmom/y bnd IdonUfy by block mambmr) 

In airborne anti-submarine warfare there is a need to more 
accurately determine the positions of sonobuoys on the surface 
of the water. This report develops two algorithms which employ 
extended Kalman filters to determine estimated position. The 
bearing from the aircraft to the sonobuoy is the primary 
measurement. Range information is not available. The first 
algorithm is a six-state filter which was reduced from the 



DO I jan ^3 1473 COITION O^ I MOV •• IS 0»SOLeTE 

S/N 010J-014-6S01 I 



1 



SECURITY CLASSIFICATION DF THIS PAGE CWhon Dmtm Sntmrmd) 



gliCUWlTY CLASSIFICATION OF THIS P*OEI''«^«o D»l« Ent«r«J- 



13-state system developed by the Orincon Corporation. Its 
states include relative position, relative velocity, and 
inertial misalignments. The second algorithm includes two 
cascaded Kalman filters. The primary two-state filter esti- 
mates sonobuoy position. A secondary filter estimates drift 
from information obtained from the primary filter. Both 
algorithms successfully estimated sonobuoy position for 
simulated aircraft data. The effect of aircraft- to-sonobuoy 
range, the frequency of measurement, and changes in altitude 
are also analyzed. 



DD Form 1473 
, 1 Jan 73 

S/N 0102-014-6601 



2 



security cl ASSI FfC ATlON OF THIS Dmt* Entmtmd) 



Approved for putlic release; distribution unlimited 



Estimation of Sonobuoy Position 
Relative to an Aircraft 
Using Extended Kalman Filters 



by 



Nicholas f^.ason Brownsberger 
Lieutenant, United States Navy 
E.S., United States Naval Academy, 1S72 



Submitted in partial fulfillment of the 
requirements for the degrees of 



MASTER OF SCIENCE IN AERONAUTICAL ENCINESRINS 

AND 

AERONAUTICAL ENOINEEfi 



from the 

NAVAL POSTCRADUAIE SCHOOL 
September 1979 



ThJS'S 
^ / 



ABSTEACT 



In airborne anti-submarine warfare there is a need to 
more accurately determine the positions of sonobuoys on the 
surface of the v^ater. This report develops two algorithms 
which employ extended Kalman filters to determine estimated 
position. The tearing from the aircraft to the sonobuoy is 
the primary measurement. Range information is not available. 
The first algorithm is a six-state filter which was reduced 
from the 13-state system developed by the Orincon Corporation. 
Its states include relative position, relative velocity, and 
inertial misalignments. The second algorithm includes two 
cascaded Kalman filters. The primary two-state filter 
estimates sonobuoy position. A secondary filter estimates 
drift from information obtained from the primary filter. 

Both algorithms successfully estimated sonobuoy position for 
simulated aircraft data. The effect of aircraf t-to-sonobucy 
range, the frequency of measurement, and changes in altitude 
are also analyzed. 
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I. INTRODUCTION 



The P3 Orion is the U.S. Navy's primary long range 
anti-sutmarine warfare (ASW) aircraft. It is outfitted with 
equipment which allows it to search for, locate, and track 
submarines. The aircraft carries a Univac digital computer, 
the CP 901, which performs much of the navigational and 
tactical plotting chores. The primary sensor used by this 
and many other ASW aircraft is an airdropped listening 
device known as a sonobuoy. The Orion generally deploys 
several sono buoys (4 to 20) in patterns which can cover a 
thousand square miles of ocean while searching for the 
submarine. Once contact has been made, these sonobuoys 
provide information which locates the submarine. The target 
can then be tracked (or attacked if required) until the 
Orion's mission is complete. 

The sonobuoy is dropped from the aircraft at the 
geographical location designated by the aircrew. Once in 
the water the sonobuoy floats and deploys a hydrophone to 
depths varying from 50 to 500 feet. The information picked 
up is transmitted back to the aircraft where it is analyzed. 
This information can consist of the relative intensity of 
target noise, bearings and sometimes ranges to the target, 
all of which are used to fix the current position of the 
submarine. In order to maintain close, accurate tracking and 
be able to launch an attack, the submarine's position must 
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te accurate to within several hundred yards. The 
inf orTiation received from the sonotuoys has some error 
inherent in the nature of the measurements made ty the 
hydrophone. Sonohuoy position error also contributes 
significantly to the submarine tracking inaccuracies. 

Historically, the positions of the sonobuoys were 
determined and updated by "mark-on-top’’s. This required the 
aircraft to home on the transmitting sonobuoy until the buoy 
was overflown. At that instant the aircraft's position vas 
entered into the on-board computer which slewed the buoy to 
this updated position. After many of these updates the 
com^-uter was able to develop a bias wnich was applied to the 
sonobuoy positions in the computer effectively allowing them 
to drift. The method had several disadvantages. Error in the 
updated position was at least as great as the aircraft 
altitude at the time of the "mark" which could vary from 300 
to 20,000 feet. The accuracy also depended on the 
consistency of the several pilots who might be making the 
mark-on-tcys during the flight. The updating was not 
continuous in that it was several minutes between 
consecutive marks on one buoy at best, and more likely 30 to 
60 minutes. Not all buoys were even updated. Furthermore, 
this method required the aircraft to overfly the submarine 
many times in order to make the mark-on-tops. This should 
be avoided. 

The purpose of this thesis was to investigate some 
alternative methods for accurately fixing the position of 
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sonotuoys. They should allow the aircraft to stand-off from 
the sonobucy field and still produce more accurate fixing 
than the historical method provided. The Naval Air 
Development Center (NADC) at Warminster, PA. had already 
partially developed such a system. This thesis was 
undertaken in support of their work but was conducted 
independently. Their system, the Sonobuoy Reference System 
(SP.S), was already installed on the aircraft and had the 
capability of measuring the relative bearing to any 
transmitting sonobuoy. Additional information available for 
use included aircraft heading, altitude, and airs^^eed as 
well as doppler velocity and drift angle. Also, the 
aircraft's Inertial Navigational System (INS) provided 
geographical ^-osition although the Schuler cycle and 
inertial drifts could make this position several nautical 
miles in error. On the other hand, aircraf t-to-scnobuoy 
range and sea surface drift information were assumed not to 
be available. An attempt was made to determine sonobuoy 
position at least relative to the aircraft with a less 
accurate geographical position as a secondary objective. 
Kalman filtering techniques were used based primarily on 
measurements of bearing from the aircraft to the sonobucy. 
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II. FILTERS 



Kal.Tian filtering is a recursive techn ique for estimating 
the state of a system. It was developed in the 1960's by 3. 
E. Kalman and improved upon previous methods by Wiener and 
others. The Wiener filter is based on frequency domain 
de signs which are statistically optimal but are only 
applicable to stationary processes. The Kalman filter is 
based on state-space, time domain formulations and is 
especially suited to digital computers. From a simplistic, 
one-dimensional point of view, the Kalman filter recursively 
averages noisy measurements to provide a more precise 
estimate of the actual value. 

Assume that a system can be linearly modeled with state 
equations in matrix form as 



k ~k-l k4 



k-1 k-i 



r w 

k-i k-i 



( 1 ) 



where X renresents the states of the system at the Kth 
k 

interval. (Only the discrete case was be considered in this 

study.) (5 is the transition matrix and is used to 
"k 

"propagate" the system from K tc K+1. U renresents the 

k 

control input to the system and W represents white, 

cC 

guassian noise with d mean and Q variance, written K(0,O ). 

k k 

Measurements are required to update the system and are 
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descrited by the linear matrix equation 




where is the measurement. describes the relationship 

between the states and the measurement and V, is measurement 

k 

noise described by N(0,R, ). 

k 

The discrete Kalman filter equations are: 

Fropaga te 



A 




(3) 




Update 



k 




X, ( + ) 
k 




( 6 ) 




(7) 



where 



A 



X, = estimate of the state X, 
k k 



k 



= covariance 



j- =• Kalman gain 



k 
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The estimate prior to the measurement is denoted by X^(-) 
and can be updated after the measurement to a new estimate 
denoted This notation is shown in figure 1. The 

covariance matrix provides a statistical measure of the 

A 

uncertainty of X. Consider a 2 x 2 covariance matrix where 
the error T in the estimate is defined as x - i : 



E(i; ) 


E(x, Xj ) 




2 

^1 


Q 

Q 

1 


1 


E ( x" ) 


II 


a, On 


2 



The diagonal elements represent the mean square errors of 
the corresponding state variables x, and The 

off-diagonal elements are indicators of cross-correlation 
between the states. The Kalman gain C is an optimal gain 
choosen so as to minimize the sum of the diagonal terms of 
the covariance matrix. 







Jigure 1. Kalman filter notation 
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If either the system model or the measurement model is 
non-linear, then non-linear filters must he used. Let the 
non-linear system be described by 






(S) 






( 13 ) 



where ) reoresents the non-linear eouations of the 

k-i * 

system. They can be linearized by a Taylor series expansion 

A 

around the latest estimate of the state to obtain 
Likewise, h(X ) represents the non-linear measurement 

iC 

A 

eo.uations and by a Taylor series expanicns yields H(X^). 



0(X^) 

h(X^) 



h(Xj^) » H(X^) 





Where 



1(X ) = ^ 
k 



) 

L 



H(X ) = i- 
k 9x 



h(X, 



i--x 



( 11 ) 



( 12 ) 



( 13 ) 
( 14 ) 



Second oraer Taylor series terms are neglected. Now, the 
extended Kalman filter can be implemented with the following 
equations : 
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Propagate 




( 15 ) 




( 16 ) 



Update 





( 19) 



( 18) 



Higher order filters can he used if the linearization 
errors are large. The second order Kalman filter employs 
one more term in the Taylor series expansion by mcdifing the 
update equations of the extended Kalman filter to account 
for this term. The iterated extended Kalman filter uses the 
same equations as does the extended Kalman filter. However, 
the calculations are repeated, each time linearizing about 
the most recent estimate, until there is little further 
improvement with each new iteration. The iterated extended 
filter can greatly reduce the errors due to non-linearities, 
more so than the second order filter. 

Kalman filters should be based on correctly modeled 
systems and accurate noise statistics to ensure proper 
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performance. This is not always possible either due to 
ignorance about the system or lack of sufficient statistical 
information. A filter which is not operating properly may 
diverge. Apparent divergence describes that situation where 
the true estimation errors are larger than the filter 
predicted errors although they are bounded. True divergence 
is characterized by errors which continue to grow with time 
and eventually become infinite. These divergence phenomenon 
are depicted in figure 2. 

There are several ways to overcome the divergence 
problem when the modeling is not completely accurate such as 
adding fictitious noise. This allows the filter a little 
more freedom to adjust to whatever modeling inconsistencies 
may exist, but makes the filter estimate appear more 
erratic. Another method which helps overcome divergence is 
finite memory filtering. Since Kalman gains tend to grow 
smaller and smaller as time passes, they may reach a point 





(a) Appaient Divergence (b) True Divergence 



Figure 2. Divergence 
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where new measurement information has no effect on the 
estimates, finite memory filtering effectively eliminates 
old data which is no longer useful hy keeping the gains 
significant. This is sometimes called a "moving window". 

Some simplifing techniques used in Kalman filters 
include precomputed gains. Although forfeiting the optimal 
Kalman gains, this has the advantage of reducing 
computational burden. More importantly, the gains can he 
controlled to overcome modeling weaknesses if necessary. 
Another technique which can he used when more than one 
measurement is provided to a filter is processing them one 
at a time. This avoids taking the inverse of more than a 
scalar when computing the updated covariance matrix ?^(+). 
This is possible if the simultaneous measurements are 
considered to be taken sequentially over a zero time span. 
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III. MODELS 



A. GENERAL APPROACHES TO SYSTEM MODELING 

The aircraf t-sonohuoy system must he modeled In 
state-space for use with the Kalman filter. There are at 
least two approaches to the modeling of this problem 
depending on the point of view. One intuitive approach is to 
assume the sonobuoy drifts at a constant velocity and then 
use ai rcraf t-t o-sonobuoy bearing measurements to locate the 
sonobuoy. The states become sonobuoy position and sonobuoy 
velocity. Unfortunately, this problem is not observable. 

The bearing measurements provide only information about 
position; there is no rate of change information in the 
bearings themselves. In addition, the aircraft must 
maintain a track of its geographical position between 
updates in order to determine the next expected measurement 
for the Kalman filter. As mentioned before, this aircraft 
position is subject to non-linear as well as linear 
navigational drifts which are not taken into account in this 
model. However, an observable system can be obtained by 
reducing the number of states to sonobuoy position only and 
introducing fictitious process noise to account for the 
drift. This noise effectively allows sonobuoy position to 
update so as to keep up with the drift. One approach 
developed by this thesis is a variation of this concept. 
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Another approach considers onl/ the relative position of 
the sonohuoy with respect to the aircraft. Relative 
velocities and relative accelerations must be taken into 
account and these change radically as the aircraft flies in 
the tactical situation. Sonohuoy position is not obtained 
directly. (When only the word "position" is used it will 
indicate the position relative to an earth fixed coordinate 
system, such as latitude and longitude. "Relative position" 
will always mean the location with respect to an aircraft 
fixed coordinate system.) 

There are some other considerations which should be 
addressed. The sonohuoy drift is generally slow (less than 
5 NM/Hr most of the time) and constant. It is not 
unreasonable to assume that the entire sonohuoy field drifts 
at the same velocity. Another point is that aircraft 
navigational drift can not be distinguished from sonohuoy 
drift. In other words, the drift that is preceived by the 
aircraft is the combination of sonohuoy drift and aircraft 
navigational drift. If this navigational drift is linear 
and not excessive it causes few problems. However, 
non-linear navigational drifts, such as the Schuler cycle, 
can cause large errors. 
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B. THE COORDINATE SYSTEM 



A right-handed coordinate syste.Ti was chosen as depicted 
in figures 3 and 4. This is a departure from the work of 
Orincon Corporation which is described in the next section. 
This system allows all angles to be measured positive in the 
direction they are normally defined, i.e., aircraft heading 
measured clockwise from north. It also coincides with the 
usual aerodynamic coordinate system. 




Aircraft heading, 



Figure 3. Earth fixed 



clockwise 



Nose 




Aircraft pitch, + up 
Aircraft roll, r. wing down 
Doppler drift angle, + r. drift 



22 



C. THE SIX-STATE SYSTEM 



Orincon Corporation of La Jolla, CA., completed a 
technical report in Decemter of 197S concerning the Sonohuoy 
Reference System. They were contracted by NADC to 
investigate the effect of errors in the aircraft 
navigational system on the performance of the sonohuoy 
tracking procedure. As a result of their work they 
developed a 13 -stfite m'^themetical model which successfully 
determined sonohuoy positions in spite of these navigational 
errors. The complete state vector was 



= 



AX, AX„ AV, AV 



’1 



1 



m, m 



1 



(23) 



where 

AX 

AV 

X 

V 

m 



relative position of the sonohuoy from the aircraft 
relative velocity of the sonohuoy from the aircraft 
position of the sonohuoy on the ocean surface; 
velocity of the sonohuoy on the ocean surface; 
inertial system's platform azimuth alignment errors 
inertial system's gyro drift rates assumed_ cons tant 



(Subscripts 1 , 2, and 3 represent North, East, and down 
respectively.) The model was developed using state equations 
which described sonohuoy motion relative to the aircraft and 
relative to the ocean's surface. These were derived by 



23 



Orincon from 



AX = X - (X^ + E) 
a 

and other mechanization equations to obtain 



( 21 ) 



AI, = A7 



1 

AX2 



1 

AV2 



AVj^ ~Rl 


2 , 
+ 03 ( 


I 

- ^al 


- ) 


3 A 2 




AV2 = -R2 


+ tM^ (^2 


- X^ 
a2 


- AX^ ) 


- ^ 3 ^^ 


- 



X. = V. 



^2 = ^2 



v„ = 



= 0 
0 



( 22 ) 



where 

X^ = aircraft inertial navigation system position 
a 

E = aircraft inertial navigation system error 
R = vector from the center of the earth to the aircraf 
g = acceleration due to gravity {assumed constant) 

= Schuler frequency y^g/R ' 

A = aircraft accelerometer outputs 



The sonobuoys were assumed to drift at a constant velocity 
and the aircraft was assumed to fly at a constant altitude. 
The inertial alignment errors were described by 
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ipj^ = sinx - 

ip^ = - 4 ;^r 2 sinx + 

ip^ = cosX 



( 23 ) 



v,tiere 



f2 = earth rate 
X = latitude 

There were several sources of measurenent information. 
Aircraft to sonobuoy bearing vas available from the aircraft 
interferometer system in the form of cos9 inhere 9 is the 
angle between the direction to the sonobuoy and the base 
line of the antenna. Doppler velocity and drift angle from 
the aircraft doppler radar system provided information about 
Av and Av^. The only other relevant source of measurement 
information vould have come from dPS (Global Positioning 
System) which would have provided error free aircraft 
position. 

Orincon performed a numerical observability analysis on 
this system based on the observability matrix given by 



If this matrix is positive definite for N^2 then the system 
is considered observable. In addition, an eigenvalue 
analysis provided information as to the conditioning of the 
system. The result of their analysis indicated that the 




(24) 



i=l 
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system was not fully observatile with measurements from the 
interferometer and doppler systems alone. Only ten states 
were observable; sonobuoy position most likely was not 
observable and mj^, m 2 * and v ^ were weakly observable 

at best. They also noted that "observability is reduced 
when the aircraft pursues a straight flight path". By 
removing sonobuoy positions and gyro drifts from the system 
they found the observability improved. Further, the system 
became fully observable if sonobuoy velocity was also 
removed from the state vector. 

The Orincon report presented the results of a 
Monte-Carlo simulation on the 13-state system. However, 
they concluded that a reduced state filter made up of 



X 



T 




Ax„ Av 



1 



Av„ :p 




(25) 



would provide a workable solution to the problem although 
they noted that it had a tendency toward divergence. It was 
partly the Intention of this report to further the 
investigation of this reduced state filter. 
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The state equations for the reduced six-state filter can 



te obtained directly from Equations (22) and (23). 
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matrix form 
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which can be abreviated 



X = 



a'' I A** 



2 , A 



X + B 



(27) 



Expressed in discrete time the state equation is 
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The discrete formulation of the plant matrix can he obtained 



from 
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from which the determinant of the system is 
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The inverse of this matrix and its Laplace transform are 
presented on the following pages as Equations (32) and (33) 
respectively. 
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sin(fisinX) t cos(QsinX) t 



The discrete formulation of the continuous matrix B is 
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= \ e " dX B 



vhere X = At - t 



( 34 ) 
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(35) 



The noise term is N(0,Q). The variances are estimated 

to te .01 NM for relative position, 1.0 (NM/Hr) for relative 
velocity, and .001 radians for inertial misalignments. As a 
result, the following constant diagonal matrix is used for 
Q: 



.01 



Q = 



.01 



1.0 



0 



1.0 



0 



.001 



(36) 



.001 



The same measurement information is available as before 
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in the larger system, namely interferometer hearings and 
doppler velocity and drift angle. These introduce non- 
linearities and must he modeled as in Equation (13). 



Z, = h(X^) . V, 



A Taylor series expansion as in Equation (11) about the 
latest estimate of sonohuoy position provides a method of 
linearization. As a result 
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To determine z and its partial derivatives, recall that 



z^ = cos0 = AX 



(36) 



where "Et is the unit vector representation of a line from 
the aircraft to the sonohuoy and HB is the unit vector 
describing the base line between the antenna pairs of the 
interf erome ter . 
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(39) 



where h is the aircraft altitude. 
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The doppler velocity, V,, is a measurement of aircraft 

d 

speed relative to the ocean surface and doppler drift angle, 
6, is a measure of the angle between aircraft track and 
aircraft heading. These measurements can be related to the 
state vector by assuming the sonobuoys drift at the same 
velocity as the ocean surface. If this is true then 
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'‘2 d 2 ' 



(43) 



Expanding in a Taylor series yields 
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Similarly 
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(48) 



or since the aircraft heading, H , is deterministic 
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The measurement noise, V^, is described by N(0,R). It 
is assumed that the measurement noise R and the plant noise 
Q are white, gaussian, and uncorrelated. Based on 
information obtained from NADC, R was assigned the following 
values : 

= .0007 rad (interferometer) 

R^ = (NM/Kr) (doppler velocity) (55) 

R^ = .01 deg (aoppler drift angle) 

It should be pointed out that the doppler measurements 
are not always available. The doppler system freezes the 
last value of groundspeed and drift angle anytime the 
doppler radar is not receiving good information. This 
happens whenever the aircraft is above 5000' altitude, or 
can happen when flying above a cloud cover or when the sea 
surface is too smooth. As a result, the doppler could be 
inaccurate during a significant portion of the flight. 

The six-state system was programmed and tested for 
several conditions. Flow charts for significant portions of 
the program and the entire program listing are presented in 
Appendix A. The main program has two purposes: first, to 

control the simulation; and second, to read and prepare 
measurement data for the subroutine FILTER. This subroutine 
performs all the Kalman filter computations as specified in 
the above equations. The Carlson square root technique is 
used to ensure a positive definite covariance matrix. Also, 
in order to avoid inverting a matrix in the calculations for 
the Kalman gain, the three measurements are processed one at 
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a time. The results of the simulation are presented in 
section IV. 3. 
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D. THE TWO-STATS SYSTEM 



An attempt was made earlier on in this research to model 
sonotuoy motion as 
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k-fl 






U 



k+l 



U 



k 



(56) 



with a state vector made up of 2 and u^. This 

system proved to he unobservable although the simple 
approach vas appealing. Since sonobuoy drift rates are 
generally slow, another attempt was made to model the system 
without velocity. The equations reduced to 



X 



k+l 




(57) 



With only and as states, this system was observable. 

3y describing large statistical values of system noise there 
would hopefully be enough freedom in the "update” to 
compensate for any sonobuoy drifts. Unfortunately, this 
approach was not completely successful; however, it was 
observed that the general direction of sonobuoy drift was 
correct. As a result of these investigations a technique of 
cascading Kalman filters was used to solve the tracking 
problem. The intent was to use results from one filter as 
measurement for a second filter. Then, the result of the 
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second filter could be used as a de ter:nin is t i c control input 
to better propagate the first filter. 

Tvo Kalman filters are used in this approach. Figure 5 
shows how they are related (or cascaded). The first filter 
models sonobuoy position and is based on the discrete state 
equation 

X, = X + U, At + W, (58) 

k k k k 

The state vector consists of the sonobuoy positions, xi and 
X 2 • Uj^ is a deterministic input accounting for sonobuoy 
drift and is system noise. The interferometer 
measurement, cos0, is used to update this filter. 




Figure 5. Cascaded Kalman filters. 



38 



The second filter models the sonobuoy drift with the state 
equation 



U 



kri 



U, 



(59) 



As the sonohuoy's position changes vith each update of the 
position filter, the velocity required to move from to 
in the time interval At can he calculated. This value is 
used as a measurement for the drift filter. All sonotuoys 
contribute to this filter which produces one cverall 
estimate of drift for the sonobuoy field. This value is 
then used as an input to the position filter when the reit 
interferometer measurement occurs. 

The technique is understandably sensitive tc the output 
of the drift filter. If the estimated drift is too much in 
error, the estimated ^.ositions will be affected. Divergence 
could result. Tor this reason, a simplified Xalman filter 
is used to estimate the drift. It is of the fcrm 



U. = U, 
k<-i k 



+ G, (Z. - U. ) 



( 6D ) 



The gain is precomputed from l/(n+l) vhere n is the total 
number of measurements and is limited to a value at least as 
great as At/(S4 min.). This limit is reached after the 
first 84 minutes of tracking time. From that point cn the 
gain remains constant effectively averaging the drift over 
one period of the Schuler cycle. It must be understood that 
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the drift this filter esti. nates consists not only of 
sonohuoy drift hut aircraft drift as well and is, in fact, 
the vector sun of these. An estimate which attenii^ts to 
follow the changing velocities through the Schuler cycle 
tends to cause the position filters to diverge. This might 
he the case if larger values of gain are used, averaging 
only the last few measurements of drift. Therefore, many 
measurements of drift are averaged which provides an 
estimate for linear drift only. The lower limit of gain 
prevents new drift measurements from being ignored and also 
provides for flexibility in estimating the drift. 

Unlike the six-state system, the interferometer 
measurement is the only measurement required by the position 
filter. The measurement equation is essentially the same as 
in the preceeding section where z is determined as shown in 
Equation (39). Since there is only one term in z, the H 
matrix is a row vector consisting of 



3 2 3 z 

3 X ^ 3 



(61) 



where the terms are given in Equations (41) and (42). It is 
necessary to determine the ai rcraf t-to-sonobuoy range for 
these values from 



AX = 




( 63 ; 



where X is the estimated sonohuoy position. X^ represents 

a 
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the aircraft position and is considered deterministic. 
Undoubtedly, is in error due to aircraft navigational 
drifts and therefore causes errors in the estimated 
geographical position of the sonoluoy. But, since the 
measurement of bearing is based on relative positions, the 
estimate is relatively correct. 

An observability analysis on the 2-state position filter 
was performed again using 



N 



= I i 



k=l 



k 4 K 



(63) 



Subtitution into this formula with N=2 yields 
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This matrix is positive definite for all except the case 
when 




This occurs whenever the relative hearing from the aircraft 
to the sonohuoy is not changing (i.e. when flying directly 
toward or away from the sonohuoy). This is intuitively 
correct since two or more hearings must cross in order to 
determine a position. 

The two-state system was programmed and tested to 
determine the usefulness of this simplified filter. The 
majority of the program is the same as the one used for the 
six-state system. The significant differences occur in 
subroutine FILTER. The Carlson square root technique is 
used again hut only one measurement instead of three is 
processed. The drift filter is programmed in this 
subroutine along with the position filter. A flow chart and 
program listing are presented in Appendix A. 
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IV. ANAYLSIS 



A. THE SII-'iULATION 

Actual data from the Orion vas not easily obtain able for 
this research. Consequently, a computer program had to be 
written to generate the information required by these 
algorithms. A flow chart in Appendix 3 describes the 
program. An aircraft track was created by alternating lines 
and curves of various lengths and then a determination of 
noise free measurements was made as the track was flown. 
(Measurement noise was added later during the simulations.) 
Sonobuoys were allowed to drift at a constant velocity, and 
the aircraft's navigational drift was modeled with a 
constant velocity and Schuler cycle variations as 

= X + K At ^ A sinojt (66) 

a a X X 



where 

= aircraft inertial position 
= aircraft true position 
(u = Schuler frequency y^g/R ' 

The constant drift rate, was found by NADC to have 3 

mean and a standard deviation of 2.5 NM/Hh. Likewise, the 
amplitude of the Schuler cycle, A^, had 3 mean and a 
standard deviation of .5 NM. The effect of wind vas also 
available in the program but was never included for analysis. 
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It v.as obvious that both algorithms vere extremely 
sensitive to the aircraft flight path. Since there is no 
"typical" flight path for an Orion during its on-station 
period, several uniform patterns were selected vhich vould 
provide meaningful information on each algorithm's 
performance. These base parameters were chosen: 
airspeed ISO kts 

altitude 3200 ft 

range 15 NM ai rcraf t-to-sonobuoy 

frequency 22 sec between measurements on one sonobuoy 

A circular pattern was flown around a sonobuoy at a range of 
about 15 Initial sonobuoy placement was at (l,l)^with 

the aircraft flying clockwise starting at (15,2). This is 
shown in Figure 6 which depicts a portion of the aircraft's 
true track. Sonobuoy drift was west at 1 NM/HRJ aircraft 
navigational drift was south at 1 NM/HR and included a 
Schuler cycle (amplitude .5 NM) when specified. (This drift 
would be indicated in Figures 12 thru 32 by the following 
notation: DR=(a/c 162-1 + Schuler, b 270-1) .) The sonobuoy 
remained near the center of the pattern allowing the range 
to remain relatively constant. This was desirable since 
this basic flight path was used to test the response of the 
algorithms to variations in altitude and range. Similarly, 
a square pattern was flown counter-clockwise around a 



L 



(x, ,x^ ) measured in nautical miles from an arbitrary 
origin near the aircraft's starting ^oint. 



sonctuoy at a range of 15 NM. In this case the aircraft 
began on-top the initial position of the sonobuoy at (-3,-3) 
and preceeded to fly the track shovn in figure 7. The 
sonobuoy was allowed to drift to the east at 2 NM/HR and the 
aircraft's navigational system to the north at 2.5 NM/KR. 
This pattern was used eventually to analyze performance at 
different measuring frequencies. Figure 8 shows the output 
of the aircraft's navigational system when it has a 
northerly drift of 2.5 NM/ER while the aircraft is flying 
the square pattern. Figure 9 shows this same pattern when a 
Schuler cycle with an amplitude of .5 NM is also present. 






POSITION (NM) 




-20. -10. Q. 10. 20. 



E-W POSITION INMl 

Figure 6. Aircraft track for the 15 NM circular pattern 

with initial sonobuoy location and direction of drift indicated. 
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POSITION (NM) 




- 20 . - 10 , 0 . 10 . 20 . 



E-W POSITION (NM) 

Figure 7. Aircraft track for the 15 NM square pattern 

with initial sonobuoy location and direction of drift indicated, 

h? 



POSITION (NM) 




E-W POSITION (NM) 



Figure 8. Aircraft's navigational output for the 15 NM 
square; navigational drift is 2.5 NM/Hr to the north. 
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POSITION (NM) 




Figure 9. Aircraft's navigational output for the 15 NM square 
navigational drift is 2.5 NM/Hr north with a Schuler cycle. 



These patterns were used to generate the data which 
included sonotuoy number, time of measurement and 
measurement, aircraft latitude and longitude, altitude, 
heading, pitch angle, roll angle, N-S acceleration, E-W 
acceleration, and the antenna used for the measurement. 
Also determined, but used only for error analysis, were 
sonobuoy position and true aircraft position. This 
information was computed for the entire Simula t ion period 
and stored in a file to be used when needed. 

Initial estimates of the state and the square root of 
the covariance matrices were obtained as follows: 
Six-state 
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(67) 



Two-state 
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( 68 ) 



where 



S (0) 
D 



indicates the diagonal elements of 5(0) 
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For the circular pattern 



I j (i2 ) 



1 . 



1 . 



X ( 0 ) = 0 . 
^2 



X ( 0 ) = 15. 



and for the square pattern 



x^(0) 



-3. 



-3. 



X (0) = -3. 
a2 



X ( 0 ) = -3 . 



The initial values of the covariance were chosen so as to 
describe the errors in the state associated with dropping a 
sonobuoy from an aircraft. The two-state system operated 
better with a lower initial variance than did the six- state 
system. 

Simulations were run for a nominal period of two hours. 
Each unit of data was sequentially read into the simulation 
program from the storage file. Measurement noise was added 
with the following normal distributions: 

CCS0 N(0,.0007) in radians 

doppler velocity N(0,1.0) in NM/ER 

doppler drift angle N(0,.01) in degrees 

These values agree with the cnes chosen for H as described 
previously. A random number generator using an initial seed 
was used to create the noise from the proper distributions. 
After the estimate was made, errors were measured and 
manipulated in subroutine RESULT. This cycle was repeated 
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until the simulation was complete. (Refer again to Appendix 
A for a flow diagram of the simulation process.) 

Information vas gathered and is presented primarily in 
two ways. First, for both the square and circular patterns 
the results of the first run of the simulation are plotted. 
(Figure 13 is an example.) The top portion of the results 
shows the estimated positions of the sonobuoy on the 
aircraft's navigational plot. It should be noted that these 
are not true positions since inertial errors may be causing 
this plot to drift. The bottom portion shows the 
North-South and East-West errors in the estimated positions. 
These errors are the differences between the true and the 
estimated relative positions of the sonobuoy. They are 
depicted in Figure 10 and were computed from 



AX, = AX, - AX, (69) 

k k k 

AX, = (X - X^), - (X - X ), (70) 

k a k a k 



where AXj^ is the relative error at time k. The true aircraft 







Figure 10. The effect of the aircraft navigational plot 
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position is denoted by X and the true geographical position 

d. 

of the sonobuoy is denoted by X. These values are known 

A ^ 

from the simulated data. X is the filter s estimate of 
position and X^ is a deterministic input from the aircraft's 

3 * 

navigational system. The errors indicated in these plots 
are different from those perceived in the upper plot 
whenever the aircraft's navigational picture is drifting. 

The positive and negative values of the square root of the 
covariance are also shown on these plots as solid lines. 
Specifically , 

N-S error = ± -/p ^ 

E-W error = ± ■/? ' 

(Only position errors are analyzed in this report.) 

The second way in which the information was gathered 
consisted of a shortened Monte-Carlo simulation. Eor each 
scenario under study, 20 two-hour simulations were run, each 
with new values of measurement noise provided by the random 
number generator from their respective distributions. The 
objective was to compare the HMS errors predicted by the 
covariance matrix in the filters to the actual RMS errors 
observed in the simulations. Three RMS statistics were 
collected and plotted versus time as follows: 

1. The square root of the covariance computed by the 
Kalman filter is represented by a solid line on the 
plots. It was computed from 
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( 71 ) 
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This standard deviation is the filter's estimate of 
its accuracy. 

2. The mean and standard deviation of the error in the 
estimated sonobuoy position relative to the aircraft 
was determined by 






a 



2 




n 

-yiS,,, n = 20, Ic = 1,2,3... 




n = 22 , k 



1,2,3... 



(72) 

(73) 



This standard deviation is represented by an 'I' on 
the plot and is a measure of the variability in the 
filter's estimated position. 

3. The RMS value of the actual relative error was also 
also determined. It was computed as 



n 

= - VaX?. , n = 20, k = 1 ,2,3. . . (74) 

k i=l 

and is represented by an 'O' on the plot. This value 
is a measure of the error which occurred between the 
actual relative position of the sonobuoy and the 
estimated one. (See Figure 11.) 

These values are plotted over the two hour si.mulation period 
(k = 1,2,3...) and provide a measure of the accuracy 
obtained by each of the algorithms. 



5 ^ 
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B. THE RESULTS 



Orincon Corporation performed much of their analysis 
using the small circular pattern shov,n in Figure 12. The 
aircraft sped around this track at 3££ knots taking a 
measurement every 20 seconds. Altitude was constant at 3000 
feet. The initial position of the sonotuoy was at (2,2) and 
it drifted on a heading of 045 degrees at 5.5 KiY/HR while 
the aircraft's navigational system drifted in the opposite 
direction at 5.2 NM/HR. A Schuler cycle was alsc 
superimposed on this drift. 

The initial estimates of sonobuoy position and variances 
used by the algor i thms were different for this particular 
pattern in order to coincide with the Orincon simulation as 
much as possible. They were 
Two-state 
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N 




CIRCLE Q ^ 

= 200 m/s 

Vg = 2.8 m/s 



Figure 12. Orincon*s simulation flight path. 
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Initially, toth the sii-state and the two-state 
algorithms were tested using this flight path and 
comparisons vere made with the results of Orincon's 13-state 
system. It was discovered that the six-state system's 
results did not change as a consequence of vhether or not a 
Schuler cycle existed in the navigational system. 

Therefore, the six-state system was run only with the 
Schuler cycle active. The two-state system was run with and 
without a Schuler cycle. 

The results of the first run of the simulation are shown 
in Figures 13, 14, and 15. The sawtooth shape of the 
covariance (solid lines) is the result of the circular 
pattern and is caused in two ways. Primarily, since the 
soncbuoy remains closer to one side of the circle, there is 
a minimum value of the variance each time the aircraft 
passes on this side. A second reason for a change in 
variance is the aircraft's location in the pattern. 

Eow’ever, these modulations are not as apparent since the 
range variation dominates. RMS errors were obtained by 
repeating these runs 20 times and are shown in Figures 16 
thru 16. The fluctuations generated by the flight path are 
apparent, more sc in the six-state system than in the 
two-state system. Also, steady state values of the error 
gradually increase. This is true because the average range 
to the sonobuoy increases as the buoy moves farther away 
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from the center of the pattern. (It will te demonstrated 
later that the errors are range dependent.) The covariance 
of the six-state system increases from 40<5 yards at 25 
minutes to 800 yards at the end of the simulation. The 
two-state system Increases slowly from 250 yards until it is 
hampered hy the Schuler cycle. It is worthy of note that 
vithout the navigational errors stemming from the Schuler 
cycle the HMS errors of the two-state system are 
considerably lover than those of the six-state system. 

Table 1 compares the RMS errors of these two systems to 
the results obtained by Orincon for their 13-state system. 
(The values for the two-state and six-state systems are 
taken from the covariance at a point 35 minutes into the 
simulation.) The first line considers measurements of 
bearing, doppler velocity, and drift angle. Navigational 
errors are present including a Schuler cycle. As expected 
there is an increase in relative position error because of 
the reduction from 13 to 6 states. The next line considers 
the effect of the Clonal Positioning System (TPS), with very 
accurate aircraft positioning information, on the relative 





13-state 


6-state 


2-s ta te 


Schuler 
SRS-^dv + DA 


394 


453 




No Schuler 
SRS+DV + DA+'CPS 




453 


200 



Table 1. Comparison of RMS results in yards. 
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position errors of the sonotuoy. In the 13-state system 
Orincon observed that the errors in the states pertaining to 
the aircraft inertials improved markedly; relative position 
errors most lively remained the same. This is exactly vhat 
was found in the analysis of the six-state system: that the 
relative position errors were unaffected by navigational 
errors. However, the two-state system is very much affected 
by navigational errors. Relative position errors were 
significantly less for the two-state system when accurate 
aircraft positions were known. 

To obtain a more realistic analysis of their performance, 
each algorithm was tested using the circular and square 
flight patterns of Figures 6 and 7. The results of the 
first simulation run for the circular path at a range of 15 
NM are shown in Figures 19 thru 21. In this case, the wavy 
nature of the covariance is due to the location of the 
aircraft in the pattern since the range to the sonotuoy 
remains relatively constant. For instance, as the aircraft 
passes directly north or south of the sonotuoy the ability 
to correct E-W errors is greatest. Therefore, the E-w 
variance reaches a minimum value at this time. The N'-S 
variance is affected in a similar manner. The two-state 
filter is not as sensitive to this as the six-state filter. 
Also, the effect of the Schuler cycle on the two-state 
filter can be seen in Figure 20. 

The RMS errors are shown in Figures 22 thru 24. The 
steady state RMS value of error predicted by the filter is 
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425 yards for the two-state and 750 yards for the six-state 
system. The actual RMS error in the relative position of 
the sonohuoy is 250 to 1200 yards for the two-state and 400 
yards for the six-state system. 'Without Schuler cycle error 
the two-state system drops to a steady 250 yards, better 
than the six-s tate system. It is interesting to note that 
the measured errors are significantly less than those 
predicted ty the filter. Roth measured values of RMS error, 
a and a , are in close agreement! that is, the deviation of 

X 3> 

the filter's estimated position about its mean is generally 
the same as the deviation of the estimated position about 
the actual relative position of the sonobuoy. The closer 
these values are to one another, the more confidence can be 
placed in the analysis. The only exception to this is 
Figure 23 which shows the reaction of the two-state filter 
to the Schuler cycle. One complete cycle with a period of 
84 minutes is obvious. The Kalman filter does not recognize 
this cycle since the modeling equations do not account for 
it. The dip in the center of the two peaks is once again 
the result of flight path geometry. The aircraft is in such 
a position relative to the sonobuoy that the measurements 
provide enough information to correct for Schuler cycle 
errors. However, it is not in this position long enough to 
influence the errors anymore than it does. 

The same analysis was performed using the square 
pattern of Figure 7. This scenerio has more drift than the 
other and in a different direction providing the algorithms 
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with another motion to track. The outcome vas generally the 
same as can be seen in Figures 25 thru 33. There is no 
measurable difference in the results from the tvo different 
flight paths. Flying a straight path does not adversely 
affect the results as was concluded by the Oricon 
Corporation for their 13-state system. The wavy nature of 
the covariance is again a result of the flight path. It is 
not as smooth as before because a square pattern was flown 
instead of a circular one. Another look at errors caused in 
the two-state system by the Schuler cycle can be seen in 
Figure 33. The algorithm does make some corrections to 
these errors but they are not as effective as before. In 
this case the time the aircraft was in a position to make 
the corrections did not coincide with the time the peak 
errors occurred. There appears to be no way to predict the 
Optimum time and place for the aircaft to be without knowing 
when and how the Schuler cycle is occurring. 

The distance the aircraft is from the sonobuoy is 
directly related to the accuracy the algorithms can achieve. 
Simulations were performed at ranges of 5, 15, 33, and 45 
nautical miles using a circular flight path with the 
sonobuoy in the center. (The RMS plots can be found in 
Appendix C.) The steady state errors were observed and are 
plotted in Figure 31. Solid lines represent the RMS values 
of the covariance and dashed lines represent the actual 
errors. In all cases the errors increase with distance 
which is intuitively satisfying. Mathematically, the 
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covariance increases because the H matrix becomes smaller 
with an increase in range. Consequently, the updated value 
of the covariance, P(+), is larger from Equation (19). For 
the six-state system there is an increase in actual error 
from 24k3 yards at 5 NM to 750 yards at 45 NM . And for the 
two-state system, actual errors increase from 130 yards at 5 
NM to 500 yards at 45 NM. (Note that for the tvo-state 
system, Schuler cycle errors, indicated by circles, peak 
approximately 1000 yards above these plotted values? the 
lower values, indicated by x's, were used since they were 
more reliable for comparison between ranges.) There is a 
slight decrease in the slopes of all the error curves as 
distance increases. Eovever, this decrease is small and the 
curves might well have been interpeted as linear within the 
limits of the analysis. 

The frequency at which measurements are made also 
affects the accuracy of the estimate. Each algorithm vas 
tested with measurement intervals of 4, 10, 20, and 30 
seconds on one sonobuoy. The outcomes of the steady state 
RMS errors are plotted in Figure 32. (Once again the 
two-state system's errors do not show the effect of the 
Schuler cycle.) The actual errors in the six-state system 
increase steadily as the measurement interval increases. 
However, the covariance decreases rapidly at first to a 
minimum value somewhere around 10 seconds and then increases 
with increasing interval. An abbreviated run with a two 
second measurement interval confirmed these results. 
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A 




Propagation effect 



Ot se rvab il i ty effect 



figure 33. factors which influence the covariance. 

Figure 33 helps to explain this outcome. There are two 
conditions which affect the covariance. The most obvious is 
the increase in covariance due to an increase in the 
propagation interval. This occurs because the plant matrix, 
which is a function of time, affects the covariance in 
Equation (16). The second condition is a consequence of the 
model's observability. If the relative bearing between the 
aircraft and the sonobuoy does not change then the state is 
not observable. In other words, two successive bearings 
must intersect to determine an estimated position. 5y 
allowing the interval between measurements to become too 
small, the aircraft is unable to make a significant change 
relative to the sonobuoy. The covariance increases as the 
conditions approach those which maice the problem 
unobservable. There appears to be an optimum frequency with 
which to make measurements on one buoy, namely 10 seconds 
for this range of 15 NM and speed of 180 knots. 
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The twc-state system exhibited similar characteristics 
in Figure 32. In this case the covariance never does 
increase in the range of intervals studied. The actual 
errors remain constant. Since the plant matrix fcr this 
system is equal to the identity matrix and the Q matrix is 
prescribed to be constant, the propagation interval, ^t, 
does not effect the covariance. However, the effects of the 
observability conditions do cause the covariance to increase 
V’hen At becomes too small. It is believed that as At 
becomes smaller the actual errors would begin to increase 
also. 

The statistical plots for the range tests found in 
Appendix 3 show that the Schuler cycle causes larger peaks 
in the actual error as the range from the sonobuoy 
increases. However, the peaks are decreasing with time. 
Further simulation revealed that the peak errors decrease to 
a steady value about 12J0 yards greater than non-Schuler 
cycle errors. This coincides with the amplitude of the 
Schuler cycle as it was programmed for this particular 
flight path. Therefore, in the steady state a Schuler cycle 
may cause additional estimation errors approximately equal 
to its amplitude. 

Altitude was also tested for any effect it might have on 
these algorithms. Using the circular pattern at a range of 
15 NM, altitudes of 300, 3000, 10,000, and 20,000 feet were 
tested. Neither the six-state nor the two-state system 
shoved any effect for these changes in altitude. It is 
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believed that at very small ranges (less than two nautical 
miles) altitude might hamper good position estimation. 
However, for the majority of the time altitude is of no 
concern . 
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Figure 13. Est. position and relative errors for the six-state system using 
Orincon's pattern. DR=(a/c 225-5.2 + Schuler, b 045-5.5), At=20s, Alt=3000'. 
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Figure 14. Est. position and relative errors for the two-state system using 
Orincon’s pattern. DR=(a/c 225-5.2 + Schuler, b 045-5.5), At=20s, Alt=3000’. 



DEL (X2) -ERROR (TDS:E-W) DEL ( X 1 )- ERROR (tD5;N 5) 




E-W POSITION INM) 





Figure 15. Est. position and relative errors for the two-state system using 
Orincon's pattern. DR=(a/c 225-5.2 + No Sch., b 045-5.5), At=20s, Alt=3000'. 
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Figure 16. RMS position errors for the six-state system while flying the circular 
pattern developed by Orincon Corp. DR-(a/c 225-5.2 F Schuler, b 045-5.5), 4t=20s, 
Alt-3000'. 
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Figure 17. RMS position errors for the two-state system while flying the circular 
pattern developed by Orincon Corp. DR=(a/c 225-5.2 + Schuler, b 045—5.5), 4t=20s, 
Alt=3000' . 
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Figure 18. RMS position errors for thr two-state system while flying the circular 
pattern developed by Orincon Corp. DR=(a/c 225-5.2 No Sch., b 045-5.5), At=20s, 
Alt=3000* . 
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Figure 19. Est . position and relative errors for the six-state system using 
circular pattern at 15NM. DR=(a/c 180-1 + Schuler, b 270-1), At=20s, Alt=3000' 
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Figure 20. Est,. position and relative errors for the two-state system using 
circular pattern at 15NM. DR=(a/c 180-1 + Schuler, b 270-1), At=20s, Alt=3000^ 
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Figure 21. Est. position and relative errors for the two-state system using 
circular pattern at 15NM. DR=(a/c 180-1 + No Sch., b 270-1), At=20s, Alt=3000' 
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Figure 22, ]IMS position errors for the six-state system while flying a 15 NM circular 
pattern around the sonobuoy. DR=a/c 180-1 + Schuler, b 270-1), At-20s, Alt-3000'. 
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Figure 23. RMS position errors for the two-state system while flying a 15 NM circular 
pattern around the sonobuoy. DR=(a/c 180-1 + Schuler, b 270-1), At-=20s, Alt-^3000' . 
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Figure 24. RMS position errors for the two-state system while flying a 15 NM circular 
pattern around the sonobuoy. DR=(a/c 180-1 + No Sch., b 270-1), t=20s, Alt=3000* . 
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Figure 25. Est. position and relative errors for the six-state system using 
square pattern at 15NM. DR=(a/c 000-2.5 + Schuler, b 090-2), At=20s, Alt=3000' 
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Figure 26. Est. position and relative errors for the two-state system using 
square pattern at 15NM. DR=(a/c 000-2.3 + Schuler, b 090-2), At=20s, Alt=3000' 
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Figure 27. Est. position and relative errors for the two-state system using 
square pattern at 15NM. DR=(a/c 000-2.5 + No Sch. , b 090-2), At=20s, Alt=3000* 
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Figure 28. RMS position errors for the six-state system while flying a 15 NM squari 
pattern around the sonobuoy. DR=(a/c 000-2.5 + Schuler, b 090-2), t=20s , Alt=3000 
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Figure 29. RMS position errors for the two-state system while flying a 15 NM square 
pattern around the sonobuoy, DR=(a/c 00-2.5 + Schuler, b 090-2), At=20s, Alt=3000*. 



2000 




84 



Figure 30. RMS position errors for the two-state system while flying a 15 NM square 
pattern around the sonobuoy. DR(a/c 000-2.5 + No Sch., b 090-2), At=20s, Alt=3000*. 
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Figure 32. RMS position error as a function of measurement interval, At, for the 
six-state and two-state systems. 



V. CONCULSION 



The following are the conculsions reached at the end of 

this research: 

1. The six-state algorithm developed in this report 
produced estimates of relative sonobuoy position with a 
standard deviation in the error of 500 yards at a range 
of 20 NM. Aircraft drift, which included the Schuler 
cycle, had no effect on this system since the states 
were defined relative to the aircraft. 

2. The two-state algorithm developed in this report 
produced estimates of relative sonobuoy position with a 
standard deviation of 300 yards plus an amount equal to 
the amplitude of the Schuler cycle error at a range of 
20 NM. When no Schuler cycle navigational errors were 
present, the two-state system out-performed the 
six-state system. 

3. Both algorithms shoved an increase in steady state ?.MS 
error with an increase in range. 

4. The six-state system showed an increase in actual 
steady state RMS error for an increase in the time 
interval between measurements? however, the covariance 
of this system indicated minimum error occurred with a 
10 second interval on one sonobuoy at a range of 15 NM 
and an aircraft speed of 180 kis. (This translates to a 
Ih degree change in relative bearing.) The two-state 
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system showed no change in the actual steady state RMS 
error for intervals between 4 and 30 seconds and only a 
slight increase in these errors as a 60 second interval 
was approached. The covariance of the system actually 
decreased with increasing interval. 

5. Neither system showed any dependence on altitudes 
within the operational limits at a range of 15 MM . 

6. Mo adverse effect was observed while flying straight 
tracks as opposed to curved ones. 

7. Steady state RMS error was affected by two conditions 
as measurement intervals changed. The longer the 
interval the more the error tended to increase, 
especially for the six-state algorithm, as a result of 
system propagation. The shorter the interval the more 
the error tended to increase as the systems encroached 
upon their non-observability condition. An optimum 
measurement interval existed for each system which was a 
function of range. 



88 



VI. SUMMARY 



Both the six-state and the tvo -state algorithms were 
able to successfully track the sonocuoy. However, the 
six-state system was the best choice given the navigational 
system in use by the Orion. It was capable of providing 
estimated sonobuoy positions at a range of 20 NM such that 
the errors had a standard deviation of 500 yards. The 
computer time required to process one measurement was on the 
order of 200 milliseconds. On the other hand, the much 
simpler two-state system required only 2S milliseconds or 
one seventh {j) the amount of computer time. However, its 
estimate of sonobuoy position was degraded by Schuler cycle 
errors in the navigational system. Without these, this 
system was subject to errors having a standard deviation of 
300 yards at a range of 20 NM. The Schuler cycle 
periodically increased these errors by an amount equal t o 
its amplitude. 

The algorithms were very much affected by the aircraft's 
flight path including the relative location of the sonobuoy, 
the range to the sonobuoy, and the amount of angular change 
in the bearing to the sonobuoy as measurements were taken. 
Since the sonobuoy position was to be estimated in 
two-dimensions, the aircraft was required tc maneuver in 
such a way so as to provide information in both dimensions. 
For example, as the aircraft crossed north or south of the 
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sonobuoy the E~W errors decreased while the N-S errors 
increased. The trend reversed when the aircraft flew east 
or vest of the sonobuoy. It was also obs erved that steady 
state RMS errors grew with range at a slightly decreasing 
rate. They were twice as large at 45 NM as they were at 15 
NM. Finally, the sonobuoy position was not observable if 
the relative bearing to the sonobuoy did not change implying 
that two lines of bearing must cross in order to obtain an 
estimated position. If the amount of angular change between 
each measurement was too small it began to affect the errors 
because this condition was being approached. Anytime the 
aircraft flew in such a way as to reduce the rate of bearing 
change, or the frequency at which measurements were made was 
too high, this condition was prevalent. It was observed 
that at least 1% degrees of change was required to avoid 
this problem. 

The six-state system showed no tendency toward 
divergence as long as initial conditions were reasonable. 

The two-state system, on the other hand, did have a tendency 
to diverge when the gains on the drift filter were not 
adjusted correctly. For example, if the gain was to high 
the estimated drift was heavily dependent on the last few 
measurements and was too quickly affected by changes in the 
position filter. But, it was also necessary for the drift 
filter to have non-zero gains in the steady state in order 
to provide some insurance against an initially wrong 
estimate of sonobuoy drift. With these modifications made 
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the algorithm operated correctly during all tests and, in 
fact, had less error in some cases than did the six-state 
system . 

It is the opinion of the author that either one of these 
algorithms is an improvement on the historical method of 
"marKing-on-top" the sonohuoy. further, it adds a great 
deal mere uncertainty as to exactly how much accuracy could 
be obtained in the old way. Non-linear navigational effects 
were not even considered and the number of measurements made 
to determine sonobuoy position was on the order of 10 or 
less for any one sonobuoy pattern. Nevertheless, in an 
operational sense the accuracies achieved here would need to 
be improved. Without the non-linear navigational errors the 
accuracies could have teen much better. However, the 
results of this research do provide another perspective for 
the problem at hand. 
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APPENDIX A 

THE COMPUTER PROGRAMS 



MAIN 




Figure 3^* 



Flow chart : 
main program 



* Required for six-state 
system only. 
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SUBROUTINE FILTER 
SIX-STATE 




Figure 35 • 



Flow charts 
six-state 



Subroutine FILTER 
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SUBROUTirrE FILTER 
TWO -STATE 




Figiire 36. Flow chart: Subroutine 

FILTER two-state 



9 - 4 - 



GLOSSARY OF C0MPUT3R VARIABLES 





SIMULATION PROGRAM 


A 


Vector of aircraft accelerations 


ALPHA I 


Result of or — 

* R “ 


ALT 


Alti tude 


ANGLE 


Direction of sonobuoy drift from North 


ANT 


Antenna 


AVEL 


Initial aircraft velocity 


AS 


T 

Matrix result of I - 

a 


B 


Matrix result of ( eSS'^ + 


BOUY 


Sonobuoy R? channel or number 


C 


Gain of drift filter 


CA 


Result of At/(84 min.) 


CE 


Constant matrix in six-s tate system's equations 


CKL 


Rate of change of nautical miles for a change In 
degrees of longitude 


D 


Array which holds all items requiring storage from 
one measurement to the next 


DELT 


Interval betineen measurements, At 


DELXl 


Relative position, ax^ 


DELX2 


Relative position, AX 2 


DELX3 


Relative position, ax 3 


DRIFT 


Magnitude of sonobuoy drift in yards 


DSEED 


Seed for the random number generator 


DTI ME 


Array of initial drop times for the sonobuoy 


DZ 


Residual , dz 


EDELXl 


Error in the est. relative position of sonobuoy, ax^ 
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ELELX2 



ELELX2 

EOSSO 


Error in the est. relative position of sonohuoy, 2 

Matrix result of e 2 


EPSLN 


Age weighting factor, 


ESST 


Matrix result of e S 


EXl 


Error in est. geographical position of sonotuoy,AX^ 


EX2 


Error in est. geographical position of sonohucy , Ax^ 


E 


f vector from Carlson square root technique 


EFT 


T 

Matrix result of ff 


EETA 


T 

f f 

Matrix result of 


ET 


Transpose of f 


n 

a 


Gain matrix 


GAMBIA 


Aircraft pitch angle, y 


GDZ 


Vector result of G dz 


GR 


Gamma in radians 


H 

H 


Aircraft heading 

The H matrix when used in subroutine FILTER 


HOUR 


Time in hours 


HR 


Heading in radians 


HT 


Transpose of the E matrix 


I 


Index 


I 


Identity matrix when used in subroutine FILTER 


lEND 


Indicator of EOF 


lEETA 


T 

f f 

Matrix result of I ~ 


IN 


File from which data is read 


INRES 


File from which true scnobuoy positions are read 


lOUT 


Device on which print is made 


lOUTF 


File in which results are written 
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lOUTZ File in which random vectors are inspected 
IRUN Index for run number 
IZ Index for measurement, z = 1,2,3 

K Incremental measure of time 

LAT Latitude 

LATI The latitude of the origin of the local earth fixed 

coordinate system 

LONG Longitude 

LONGI The longitude of the origin of the local earth fixed 
coordinate system 

MARK Indicates whether information is to be stored 
or retrieved 

MEAN! Mean estimated sonobuoy position, m 

MEAN2 Mean estimated sonobuoy position, uz 

MIN Time in minutes 

N Total number of measurements made on all sonobuoys 

N Index when used in subroutines IN ITAL and DATA 

MRUNS Integer equivalent of RUNS 

0 Plant matrix, I 

OS Matrix result of $ S 

OST Transpose of ^ s'^ 

OSSO Matrix result of I'^S^S ^ 

OX Matrix result of f X 

? Covariance matrix 

PHI Aircraft roll angle, f 

PI 7T 

PR Phi in radians 

Q Variance of plant noise from N(0,Q) 

R Variance of measurement noise from N(3,R) 
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RAD 


n /180 


RANGE 


Range to sonobuoy from aircraft 


RANGE2 


Squared value of range 


RBI 


Unit vector component of antenna baseline 


RB2 


Unit vector component of antenna baseline 


RE3 


Unit vector component of antenna baseline 


REX 


Result of (RBj A^i + RB2 a3^2 ''' 


RNO 


Normally distributed random number from N(0,l) 


RUNS 


Number of simulation runs to be made 


S 


Array in Carlson's square root technique which 
represents square root of covariance matrix 


SI 


Square root of variance, /Pn 


S2 


Square root of variance, >^P 22 


SEC 


Time in seconds 


SF 


Matrix result of S f 


SIGMA 


RMS error in the estimate about the actual location 


SIGMAF 


RMS value from the Kalman filter, i^Pi i + F 22 


SIGMAX 


RMS error in the estimate about the mean estimate 


SKL 


Rate of change of nautical miles for a change in 
degrees of latitude 


SNSXr 


Propagated matrix of S 


SST 


Matrix result of S s'^ 


ST 


Transpose of S matrix 


SUMPl 


Array for the sum of P(l,l) over NRUNS 


SUMP2 


Array for the sum of P(2,2) over NRUNS 


SUMSQl 


-^2 

Array for sum of Ax^ over NRUNS 


SUMSQ2 


~2 

Array for sum of Ax^ over NRUNS 


3UMX1 


Array for sum of a”Xj^ over NRUNS 
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SUMX2 


Array for sum of AJ 2 over NRUN3 


T 


Last time in seconds the sonobuoy was processed by 
the filter 


TIME 


Time from aircraft clock: in seconds 


U 


Sonobuoy drift vector 


U1 


Old value of U{ 1 ) 


U2 


Old value of U{2) 


VARl 


Variance of the estimated sonobuoy position about 
the actual location 


VAR2 


Variance of the estimated sonobuoy position about 
the actual location 


VARXl 


Variance of the estimated sonobuoy position about 
the mean estimated nosition, , 


VARX2 


Variance of the estimated sonobuoy position about 
the mean estimated position, 

x2 


VELCT 


Relative velocity, aV 


VELCT2 


Squared value of relative veclocity 


X 


State vector 


XAI 


Aircraft inertial position, X^ 

a 


XAT 


Aircraft true position, X 

a 


XI 


Old value of X(l) 


X2 


Old value of X{2) 


X3 


Vector including XBl, XB2, velocity of sonobuoy, and 
two zeros used in the six-state system 


XBl 


True geographical location of sonobuoy, x^ 


X32 


True geographical location of sonobuoy, x^ 


XBII 


Array of initial sonobuoy positions 


XB2I 


Array of initial sonobuoy positions 


XNEXT 


Propagated value of X 


Z 


Measurement vector 
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ZHAT 

ZN 

ZU 



Estimate of z 

Normally distributed random number from N(z,R) 
Vector of velocity measurement for drift filter 
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APPENDIX B 

COMPUTER PROGRAM FOR DATA GENERATION 



DATA GENERATION 




Figure 3?. Flow chart: data generation program. 
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GLOSSARY or COMPUTER VARIABLES 



DATA GENERATION PROGRAM 

A Vector of aircraft accelerations 

AL Altitude in nautical miles 

ALT Altitude 

ANT Antenna 

AVSL Initial aircraft velocity 

AXl Amplitude of Schuler cycle, A,, 

A • 

AX2 Amplitude of Schuler cycle, A^^ 

B Intercept on N-S axis of straight track 

BANG Sonobuoy drift direction 

BOUT Sonobuoy RE channel or number 
BVEL Sonobuoy drift direction 

CKL Rate of change of nautical miles for a change in 

degrees of longitude 

D Length of straight track 

DELT Interval between measurements. At 

DELVl Relative velocity, Avi 

DELV2 Relative velocity, AV 2 

DELXl Relative position, a^^ 

DELX2 Relative position, ax 2 

DH Total change in heading while on curved track 

DSEED Seed for the random number generator 

END Indicator of EOF 

G Gravitational acceleration 

gamma Aircraft pitch angle, y 
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GR Gamma in radians 

H Aircraft heading 

KNEW Pinal heading on curved track 

HOUR Time in hours 

HR Heading in radians 

lOUT Device on vhich print is made 

lOUTP File in which results are written 

lOUTR Pile in which true sonohuoy positions are written 

lOUTZ Pile in which random vectors are inspected 

ITIME Time from aircraft clock in seconds 

KXl Rate of linear navigational drift, 

KX2 Rate of linear navigational drift, K 

x2 

DAT Latitude 

LA*TI The latitude of the origin of the local earth fixed 
coordinate system 

LONG Longitude 

LONGI The longitude of the origin of the local earth fixed 
coordinate system 

LTIME Array of initial drop times for the socohuoy 
M Slope of straight track 

MARX Indicates the first time a buoy is to be proccessed 
MIN Time in minutes 

N Index 

NBOUY Total number of sonobuoys 
N3TOP End of line or curve series 
PHI Aircraft roll angle, p 

PI IT 

PI2 2tt 
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SEC 
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V 

VAl 

VA2 

V31 

VB2 

WANS 

WVEL 

XAI 

XAT 

XBl 

XB2 

XCl 

XC2 

XXI 

XX2 

Z 



Phi in radians 
Radius of curved track 

Unit vector com^jonent of antenna baseline 
Unit vector component of antenna baseline 
Unit vector component of antenna baseline 
Distance aircraft travels in time At 
Time in seconds 

Rate of change of nautical miles for a change in 
degrees of latitude 

Direction of aircraft travel over the ground 

Direction to center of curved track 

Direction from center of curved track to aircraft 

Velocity of aircraft 

Velocity of aircraft 

Sonobuoy drift 

Sonobuoy drift 

Wind direction 

Wind velocity 

Aircraft inertial position, X^ 

a 

Aircraft true position, X 

a 

True geographical location of sonobuoy, 

True geographical location of sonobuoy, 

Location of the center of the curved track 

Location of the center of the curved track 

Incremental change in X^ 

Incremental change in X 

2 

Measurement vector 
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Figure 38. RMS errors for two-state system (top) and six- 
state systan (bottom) using circular pattern at 5 NM. 
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Figure 39* RMS errors for two-state system (top) and six- 
state system (bottom) using circular pattern at 30 NM. 
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Figure 4o . RWK errors for two-state system (top) and six- 
state system (bottom) using circular pattern at 45 NM. 
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Figure 41. RMS errors for two-state system (top) and six- 
state system Cbottom) using square pattern with t=4 sec. 
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Figure 42. RMS errors for two-state system (top) and six- 
state system (bottom) using square pattern with t=10 sec. 
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Figlire 43* RIVB errors for two-state system (top) and six- 
state system ("bottom) using square pattern with t=30 sec. 
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Figure 43- RMS errors for two-state system (top) and six- 
state system (bottom) using circular pattern, Alt=300'. 
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Figure 45. RMS errors for two-state system (top) and six- 
state system (bottom) using circular pattern, Alt=10,000'. 
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Figiore 46. RMS errors for 1rwo-state system (top) and six- 
state system (dottom) using circular pattern, Alt=20,000'. 
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